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A PASSIVITY BASED CONTROLLER FOR SPACE MANIPULATORS 


Abstract 

A feedback linearization technique is used in conjunction with passivity concepts to design robust controllers 
for space robots. It is assumed that bounded modeling uncertainties exist in the inertia matrix and the vector 
representing the coriolis, centripetal, and friction forces. Under these assumptions, the controller guarantees 
asymptotic tracking of the joint variables. A Lagrangian approach is used to develop a dynamic model for space 
robots. Closed-loop simulation results are illustrated for a simple case of a single link planar space manipulator with 

freely floating base. 


1. Introduction 

Hie dynamics of the space manipulators differs from that of the ground based manipulators since their base, the 
spacecraft, is free to move. The movement of the manipulator produces reaction forces and torques on the base. 
Therefore the resulting motion of the spacecraft has to be accounted for in the dynamic model for the manipulator. 
However, Papadopoulos and Dubowsky [1] showed that a dynamic model for space robots developed by taking into 
account the motion of its base is similar in structure to dynamic models of fixed base manipulators. For instance, the 
inertia matrix in each case is symmetric and positive definite. 


A few concepts have been proposed for joint trajectory control and inertial end tip motion control of space 
manipulators. Vafa and Dubowsky [2] developed an analytical tool for space manipulators, known as the virtual 
manipulator concept The virtual manipulator is an idealized kinematic chain connecting its base, the virtual base, to 
any point on the real manipulator. This point can be chosen to be the manipulator’s end effector, while the virtual 
base is located at the system center of mass, which is fixed in inertial space. As the real manipulator moves, the end 
of the virtual manipulator remains coincident with the selected point on the real manipulator. Additionally, it can be 
shown that the change in orientation in the virtual manipulator's joints is equal to the change in the orientation of the 
real manipulator’s joints. While these features give the designer the ability to represent a free floating space 
manipulator by a simpler system whose base is fixed in inertial space, the associated transformation depends on 
knowing the system parameters exactly. Alexander and Cannon [3] showed that the end tip of the space robot can 
be controlled by solving the inverse dynamics that includes motion of the base. Their method assumes the mass of 
the spacecraft to be relatively large compared to that of the manipulator it carries, and also requires much 
computational effort to determine the control input Note that future systems are expected to have the manipulator 
and spacecraft masses of the same order. Umetani and Yoshida [4] proposed the generalized Jacobian matrix that 
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relates the end tip velocities to the joint velocities by taking into account the motion of the base. The control method 
presented in the above reference is based on the concept of Resolved Motion Rate Control and Resolved 
Acceleration Control. However, robustness of the control scheme to modeling uncertainties is not discussed. 
Masutani etaL[5] proposed a sensory feedback control scheme based on an artificial potential defined in the sensor 
coordinate frame. This scheme is based on proportional feedback of errors in the end tip position and orientation as 
well as feedback of joint angular velocities. 

In this report a robust control scheme based on feedback linearization and passivity concepts is proposed for 
space robots. A similar control scheme has been proposed earlier for fixed base robots by Abdallah and Jordan [6]. 
The extension to space robots is in the spirit of the [1], where it was proposed that due to the striking similarity in 
the structure of the equations of motion of fixed base and space robots; almost any control scheme used for fixed 
base robots can be applied to space robots. The control scheme uses inverse dynamics; however, it is robust in the 
face of bounded modeling uncertainties which might be due to imprecise modeling and/or intentional simplifications 
to the model based control law in order to reduce computational effort The controller asymptotically tracks 
prescribed time varying joint angle trajectories whose acceleration is bounded in the space. 


2. Dynamics of Snace Manipulator System witho ut Attitude Control of the Base 


The development of the equations of motion for space robots presented here closely follows that given in [5]. A 
spa r* manipulator system in the satellite (Mbit can be approximately considered to be floating in a non-gravi rational 
environment As shown in Figure 1, the manipulator and the base can be treated as a set of n+1 rigid bodies 
connected through n joints. The bodies are numbered from zero to n with the base being 0 and the end tip being n. 
Each joint is then numbered accordingly from one to n. The angular displacements of the joints can be represented 
by a joint vector. 


q = [q x q 2 ...q n l 


T 


( 1 ) 


The mass and inertia tensor of the i* body are denoted by m i and Ij. and the inertia tensor is expressed in the base 
frame coordinates. 

2.1 Kinematics 

A coordinate frame fixed to the orbit of the satellite can be considered to be an inertial frame, denoted by 2* In 
addition to Zj, another coordinate frame Zb is defined that is attached to the base with its origin located at the base 
center of mass. The attitude of the base itself is given by roll, pitch, and yaw angles. In the sequel, all vectors are 
expressed in the base fixed coordinate axes. 


2 


Link i 


Base Frame 



System 
Center of 
Mass 


Orbit 
Inertial Frame 


Earth 


Figure 1 . A Space Robot 


Let Vi be the linear velocity of the center of mass of the P link with respect to the inertial frame. Also, for the 
i* link, let fii be the angular velocities with respect to the inertial frame, and let ©i be the angular velocity with 
respect to the base frame. Then Vj and fli can be written as 

Vi - Vb + vi + Ob x r i ( 2 ) 

Qj = £2 b + ^ 

where r, is the position vector of the center of mass of the i* body with respect to the base center of mass, and 
v . = f . . Vb and Qb are the center of mass linear velocity and angular velocity respectively of the base with respect 

to the inertial frame, v; and <04 for each link can be represented by the following forms 


Vj = J u (q)4 


( 4 ) 
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®i = JAifato 


(5) 


w bcrc Ju(q) and JAi(q) e R3xn * e Jacobian matrices for the i* link . 

The position of the system center of mass with respect to the base frame depends cm the joint angles. Given 
below are two measures related to the system center of mass 

m c = S m i 

i-0 


r c Cq)= Zn»i«'i(q)/ m c 

i«0 


(7) 


22 Dynamics 

The total kinetic energy of the space robot can be written as 

T = lq T D(q)q, DeR“*“ (8) 


where D is the inertia matrix of the system and is given by 


«b.(& “-]"[£] 


(9) 


It can be shown that D = D T > 0. Hq is the inertia matrix corresponding to the fixed base manipulator 

H, = i[miJLJu+JLv4 H q e R nxn 

i*l 


00 ) 


The second term on the right hand side of Equation (9) arises due to the fact that the base of the space robot is free. 
Since the working environment is non-gravitational and no actuators generating external forces are employed, the 
Unear and angular momenta of the whole system are conserved. Since the inertial frame is fixed to the orbit, the 
whole system can be assumed to be stationary with respect to the inertial frame at the initial state. Thus the above 
two momenta are always zero for the whole system. Note that it is implicitly implied that the satellite is a non- 
spinning body. Using the assumption of zero initial momenta the individual components comprising the second 
term on the right hand side of Equation (9) can be written as 
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( 11 ) 


where for any vector 


H v = m e I 3x3 , H ¥ gR 3x3 

H 0 = II i + ini i [r i x] T [r i x]. H q gR 3x3 
i=0 i=l 

H vQ = -m c [r c x],H vQ GR 3x3 
= u , H vq €R 3xn 

i*I 


H 0 , = i{l i J A i + m i [r i x]J u }, H^gR 3 ™ 

i=l 


[fx]- 
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-u 

o 

fi 


f 'N 
l 2 

-f { 

o j 


(12) 

(13) 

(14) 

(15) 


(16) 


(17) 


and 1^x3 is the 3x3 identity matrix. 


Since there is no potential energy in non-gravitational environment, the Lagrangian, A, is equal to the kinetic 
energy 


A = T 


(18) 


So the system dynamics is given by 



where x is an nxl vector of input torques. Paralleling the development for fixed base robots given by Spong and 
Vidyasagar [7], the equations of morion for space robots can be written as. 
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D(q)q + h(q,q) = T . 


( 20 ) 


where 


h(q,q) = C(q,q)q 


( 21 ) 


and the elements of the matrix C are given by 





3D* 

3q k 




( 22 ) 


2.3E22£-M2llQQ 

The conservation of linear and angular momenta yields expressions for the base translational and angular 
velocities 



(23) 


Using the above expressions, the evolution of the base position and orientation with time can be determined as 
follows 


A 


CyCg 

c ¥ s 0 s* s ¥ c^ 

c ¥ s*c* + V* 

*b 

= 

s ¥ c 0 

+ c ¥ c^ 

S ¥ S 0 C 4 “ c ¥ s 4 

A. 


-S 0 

c e s^ 

c e c * 




1 s*tan(0) c 4 tan(0) 

0 

= 

0 c* -s* 

V 


0 s + sec(0) c + sec(0) 


(24) 


(25) 


where 


c (0 ■cos( ),s ( ) *sin() 


(26) 
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3. Control System Design 


3 1 Feedback Linearization 

Assuming that the dynamics of the space robot is described by Equation (20), where D and h are completely 
known, the feedback linearization or inverse dynamics technique [7] can be used to design controllers for tracking 
prescribed command trajectories for the joint angles. This can be accomplished by letting 

t = Du + h (27) 

where u is the pseudo-control, i.e., it is die control input to the linearized system. With the control law given by 
Equation (27), the closed-loop system becomes 


f • ’ 

q 

A 




+ Bu 


(28) 


where 



(29) 


A simple PD (Proportional-Derivative) type of control law is chosen for the feedback linearized system 


u = q a +K 2 (q d -q) + K,(q <1 -q) (30) 

where Ki and K 2 are proportional and derivative gain matrices, respectively. These matrices are usually chosen to 
be diagonal in order to achieve decoupled response among the joint angles. Substituting for u from Equation (30) 
into Equation (28), one obtains 


e = A c e (3D 

where e = {e* ej^.e, = q d - q. e 2 =q d - q, A e = A-BK, and K = [Ki K 2 ]. If Kj > 0 and K 2 > 0, the error 
dynamics as given by Equation (31) is asymptotically stable. The freedom in selecting the gain matrices can be 
utilized to meet performance specifications for the closed-loop system. 

The preceding discussion assumes availability of perfect knowledge about the system dynamics. However, in 
practice, D and hare usually imprecisely known due to modeling inaccuracies. Furthermore, D and h may be too 
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complex to be used for real-time control implementation. In the following sub-section, a control law that is robust 
for bounded uncertainties in D and h is given. The control law results in closed-loop asymptotic tracking. 


3 2 Rnhnst Feedback Linearization Using Passi vity 

The development in this section follows that given in [6] very closely. In the presence of modeling 
uncertainties, the control law is given as 

T = D c u + h c < 32 ) 

where D c and he are computed versions of D and h respectively. Substituting for x and u from Equations (32) and 
(30) into Equation (20) it can be shown that the closed-loop system dynamics is given by 

fc = A c e+Bv ( 33 ) 


where 


v = Au + 5 


(34) 


and 


A = (I - D -1 D C ), 5 = D -1 (h-h c ) 


(35) 


The first step in the design proposed in [6] is to choose the gain matrix K = [Kj K 2 ] and an output matrix F such 
that the linear system given by 


e = A c e + Bv 
y=Fe 


(36) 


is SPR (Strictly Positive Real). This can be achieved as outlined in the following theorem. A definition of the 
concept of Strictly Positive Realness can be found in Slotine and Li [8]. 


Theorem 1 [6]. Let Kj and K 2 be such that 


K, =diag[k li ];k li >0,i = l,...,n 

K 2 = diagfk^l; kjj > 0, i = 1 n 

(k 2i ) 2 >k u , i = l,...,n 
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then if F = K, the system described by Equation (36) is SPR. 


The proof is omitted here, the interested reader is referred to [6]. Note that the conditions of the theorem given in 
Equations (37) are extremely easy to satisfy. 


With the linear system (37) being SPR, the passivity theorem (Desoer and Vidyasagar, [9]) can be used to 
design asymptotically stable controllers as shown in the following theorem. The theorem is very similar to that 
given in [6], with the only difference being in the way in which the uncertainty bound on the h vector is 

(t y /2 

characterized. The notation jxjj = J x T x dt is used in die sequel. 

vo ; 


Theorem 2. Let the following two inequalities hold 

DS-I (r>0) 
r 

|d — 1 (h - h c )| T £ cHr + d VT>0 (c*0,~>d£0) 
Furthermore, let q«j e L 2 . Then if D c = al where 


(38) 

(39) 


(40) 


the closed-loop system is asymptotically stable. 

Proof. The closed-loop system as given by Equation (33) can be represented in block diagram form as shown in 
Figure 2. It is Fust shown that the nonlinear block in the feedback path is passive [9]. 



Figure 2. Robust Feedback Linearization Using Passivity Theorem. 
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Consider 


I = J -u T vdt (T> 0) 
o 

T _ 

= J-u t (Au + 5)dt 
o 



Let the first and second integrals on the right hand side be denoted by It and I 2 respectively. Then 

T 

I 1 = Ju T (aD" 1 -I)udt 
0 


(41) 


(42) 


Noting that 


DS-I => aD _, -I£(ar-l)I 
r 


(43) 


one can obtain 

Ii 2 i(ar-l)|u|* ■ 


(44) 


On the other hand. 


-I 2 = J u t D _1 (h - h c ) dt 
0 

<, luIrlD'^h - he^j. (Holder' s Inequality) 

*Mr[ c Hr + d l 


(45) 


Hence 


I * (ar - c - l)|u| 2 - d|u| T = f (Mr) 


(46) 


It can be shown that if (ar - c - 1) > 0, then 


d 2 

4(ar - c - 1) 


* 14^0 


fH) 1 - 


(47) 


Hence 


J-u T vdte- - - VT>0 < 48 > 

o 4(ar-c-l) 

Hius a sufficient condition for the nonlinear block to be passive is that a > (c + iyr. 

Additionally, the transfer function of the feedforward block [Ac, B, K] is proper and has no poles on the 
imaginary axis. Hence it has finite gain (Doyle, Francis, and Tannenbaum, [10]). Since q d € L 2 , then using the 

passivity theorem [9], one can conclude that the signals u, Ke, and v are bounded. Moreover, since the feedforward 
block is SPR, Ke(t) = Kie,(t) + K^t) goes to zero asymptotically. This in turn implies that e,(t) and e 2 (t) 

individually approach zero asymptotically [8]. 


The first condition of the theorem, given by Equation (38), is easy to satisfy since D is upper bounded. 
However, the second condition, given by Equation (39), might not be easy to verify in a straightforward manner in 
all applications. 


4. Simulation Results 

As an example, results are illustrated for a single link space robot shown in Figure 3. Equation (20) describes 
the dynamics of this one degree of freedom system. The system inertia, computed using Equation (9), turns out to 

be 

D(q 1 ) = m'Pf + Ii -ifm'Pj^oC! +P0 + I.1 2 (49) 


where 


d = m'(P 2 +P? + 2P 0 P,c,) + I 0 + I, (50) 

and m' = m 0 mi / (m 0 + mj ) • Using Equations (21) and (22), h is determined to be 

h(qi»Qi) = ~^^ 1 ^’[ m ^ > o(P 0 + P 1 c 1 ) + Io]‘[ ,1,, Pi(PoC 1 +Pi) + IilQ? ( 51 > 

In Equations (49) through (51), c, « cosfa^.Si ■ sui^). 
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End Tip 





Figure 3. A Single Link Planar Space RoboL 


It can be seen easily that as mo °°> and k) °°» 


D-^mjPf + Ij, h-»0 


(52) 


which represents the case of a fixed base manipulator. Equation (24) is used to determine the evolution of the base 
position with time 


x b = ~[p» s v, “^{m'P^PoCi +Pi)+I.}(P»V + P o s v)K 
y b ~[- p i<V +^{m' p i( p oC, + Pi) + I,}( p tc. +P 0 c ¥ )]qi 


(53) 


where 


s fl = sin(y + qj ), = cos(y + q,) 


( 54 ) 


Finally, the base attitude dynamics is obtained using Equation (25) 
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(55) 


V = -^[m'l > i(P 0 c, +Pi) + Ii]qj 


Next, a f ee dback controller is designed for the space robot using the results of Theorems 1 and 2. Closed-loop 
results are generated for a step command of 1 radian to the joint angle. Note that in general, for end tip motion 
control in the inertial space, the inverse kinematics problem needs to be solved to generate a command trajectory for 
the joint angle. Table 1 lists physical parameters of the example robot used in simulation. The base and link masses 
are of the same order of magnitude. The feedback gains are chosen to be ki = 0.4 and k 2 = 1.0. This choice of gains 
satisfies Equations (37) and in case of no modeling uncertainty, yields a closed-loop response without any 
overshoot The fact that the system center of mass should remain stationary in inertial space is used to monitor the 
step-size of integration to achieve numerical accuracy. Simulation results are shown for the case in which there is 
no modeling uncertainty, and for two other cases that involve differing degrees of uncertainty. It is assumed that 
Equations (20) and (49) through (51) represent the true robot; the uncertainty is introduced in computing D and h. 
An upper bound for the system inertia, needed for condition (39) of Theorem 2, is given for this particular case by 

I = m'P? + I 1 (56) 

r 

a in Theorem 2 is assumed to be 1.1/rfor both cases involving uncertainty. The choice of he however, is different 
for the two cases. In the first case, the following simplification to h is used for computing the closed-loop control 


h c = mT 0 P 1 Siq t ( 57 ) 

The second case corresponds to an even greater simplification to h 

h c = rnTJ^q, (58) 

Figures 4 through 7 show closed-loop results for the nominal case and for the first case involving uncertainty, c 
= 0.01 was chosen to satisfy condition (41) of Theorem 2. d was chosen to be 2.5. Figure 4 shows that asymptotic 
tracking in the joint angle is achieved in the face of uncertainty. This is associated with a slight performance 


Table 1. Physical Parameters of Example Robot. 












BSH 
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*^o»in.h e jota..ngle, B po ra eto^ Hg* 5 .hows d« high* -*•*- 

of jouitlorque are required fas Iheca* involving uncertainty. Figures 4 and 6 show that lire base moves in reaction 

to link motion; this is due to the conservation of linear and angular momentum as discussed previously. However, 
•e joio. angle still achieves the right commanded «lue. Figure 7 *>«s Ho* the choice ct e and d used at tins case 

fftig fifts condition (40) of Theorem 2. 



Time (seconds) 


Figure 4. Joint and Base Angle Responses for the 
Nominal Case and the First Case 
Involving Uncertainty. 



o 5 10 15 20 


Time (seconds) 

Figure 5. Joint Torque Input for the Nominal 
Case and the First Case Involving 
Uncertainty. 



Time (seconds) 

Figure 6. Motion of the Base Center of Mass for the 

Nominal Case and the First Case 

Involving Uncertainty. 



Time (seconds) 


Figure 7. cluk + d - |D" l (h - h,^ for the 

Nominal Case and the First Case 
Involving Uncertainty. 
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Joint and Base Angles (rad) 


Figures 8 through 11 show closed-loop results for the nominal case and the second case involving uncertainty. 
For the second case, c and d are chosen to bee -0.01 and d- 5.0. Trends similar to the previous case are indeed 
berealso. However, since the extent of uncertainty is greater, there is more deviation in the responses as compared 
to die previous case. This is observed in Figures 8 through 10. Figure 11 confirms that the choice of c and d 
satisfies the requirements of Theorem 2. 



Tune (seconds) Tune (seconds) 


Figure 8. Joint and Base Angle Responses for the 

Nominal Case and the Second Case 
Involving Uncertainty. 


Figure 9. Joint Torque Input for the Nominal 
Case and the Second Case 
Involving Uncertainty. 



Time (seconds) 


Figure 10. Motion of the Base Center of Mass for the 

Nominal Case and the Second Case 
Involving Uncertainty. 



Time (seconds) 


Figure 1 1 . duJr+d-lD^Oi-h^forthe 
Nominal Case and the Second Case 
Involving Uncertainty. 
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5. Conclusions 


A control method based on feedback linearization and passivity concepts that was proposed earlier for fixed 
base robots is modified and extended to the case of space robots. The control law results in asymptotic joint angle 
tracking in the face of bounded uncertainties. For the first time, closed-loop simulation results are {Resented using 
this control method. For the simple example illustrated in the report, the control method shows promising results. 
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